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Precede et dlsposKH pour la detection et la localisation ©"obstacles dans r envlronnement d*un vehteule. 
(^LHnven^ 

cSusation d'obstacles dans renvlronnement <fun vehlcule. 
Acet effet, D oornprerid les stapes consistartt & 6mettre des 
signaux en direction dudlt envlronnement & partir d'une plu- 
rality de radars (2) disposes sur le vehlcule, & deduire des 
sigrtaux recus en 6cho les probability d'occupation par un 
obstacle d'un ensemble de cellules 6l6mentalres (9) dudit 
envlronnement, et & fuslonner les probability relatives & 
chacune desdites cellules. 
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A 

Proc6d6 et dispositif pour la detection t la localisation 
d'obstacles dans Tenvironnement d'un v6hicu!e 

La presente invention concerne un procede et un dispositif pour la detection et 
la localisation ^obstacles situes dans I'environnement d'un vehicule arrete ou 
en mouvement. 

Une fonction importante de la robotique mobile concerne la detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur, dans la 
mesure ou ceux-ci peuvent entraver son mouvement et doivent etre 
contournes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamment distants ou dans une direction telle que le 
vehicule peut.continuet.son. chemln.s<aa&,6cart,. J9 >~_ SmA 

Un aspect secondaire de cette detection consiste a exploiter une connaissance 
a priori du positionnement (absolu) de Tobjet detecte par rapport a une carte ou 
un site plus vaste, pour qu'en detectant cet objet et . en mesurant ses 
coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
vehicule et permettant d'en mesurer les coordonnees consiste a utiliser des 
capteurs d ultra-sons. 

Selon cette technologie bien eprouvee, une onde acoustique est emise 
— periodiquement et, se trouvant reflechie par les objets^ constituant - des 
obstacles & sa propagation, revient vers le capteur apres un temps de retard, 
lequel depend directement de la distance de I'objet ainsi d6tecte. 

Pour assurer la detection peripherique d'un vehicule, il convient de disposer un 
nombre suffisant de tels capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre est d'autant plus eleve que les 
capteurs auront un lobe de detection etroit. 

Uutilisation de ces capteurs fournit une information de distance par rapport a 
un obstacle, mais Tinformation d'orientation angulaire est d'autant moins bonne 
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que les capteurs sont a lobe large. En effet, dans la mesure ou un capteur voit 
un obstacle donne non pas en un point de I'espace mais de manifere ambigue 
en tous points situes a egale distance, si Ton associe plusieurs capteurs pour 
assurer la couverture du perimetre du vehicule, redetermination de la position 
5 angulaire des obstacles detectes peut etre excessivement grande. 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accrott le cout global de la detection. 

10 Un autre inconvenient de ('utilisation de capteurs a ultra-sons est leur tr£s 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, I'echo pouvant meme etre souffle et ne jamais revenir a sa source; 

15 La pr6sente invention vise a pallier ces inconvenients. 

A cet effet, invention a tout d'abord pour objet un procede de detection et de 
localisation des obstacles situes dans Tenvironnement d'un v§hicule, 
caracterise par le fait qu'il comprend les Stapes consistant a emettre des 
20 signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux regus en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules elementaires dudit 
environnement, et a fusionner les probabilites relatives a chacune desdites 
cellules. 

25 

Des algorithmes de fusion d'informations sont d6ja connus dans la technique. 
Toutefois le fait de fusionner des probabilites cToccupation de cellules 
elementaires, ces probabilites etant elles-memes obtenues a partir de signaux 
radar, peut donner, avec la technique selon I 1 invention, des resultats tout & fait 
30 surprenants par leur precision, perrnettant meme la cartographie des obstacles 
detectes et rendant done possible leur evitement ainsi que la localisation du 
v6hicule lui-m§me, du fait de la grande qualite de la modelisation de 
Tenvironnement ainsi effectuee. 

35 Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en ext6rieur et par tout temps. 
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Enfm on a pu constater que I'invention permet meme d'utiliser des radars de 
performance individuelle relativement mediocre sans alterer les n§sultats de la 
modelisation globale. 

5 

Dans un mode de realisation de I'invention, la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

10 Dans ce cas t la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retournees simultanement par un sous-ensemble de radars ayant 
detecte un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
is probability fournie par un radar et la valeur de la probability anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere temporelle, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
20 temps que le vehicule. Dans ce cas, Pop6ration de fusion est appliqu£e a la 
valeur deja affectee a la cellule. 

On peut deduire des signaux regus en echo une information de distance et une 
information angulaire sur les obstacles et determiner lesdites probabilites 
25 d'occupation d partir de ces informations. 



De preference on prevoit une etape de seuillage des r^sultats de la fusion de 
maniere a obtenir une carte depouillee des artefacts divers pouvant provenir 
de reflexion speculaires ou multiples, des ondes radars emises. 

30 

Selon un mode de realisation particuliere de I'invention, le signal emis par les 
radars est module en frequence, le signal re$u en echo est melange a une 
fraction du signal emis pour, apres elimination de la frequence, po.rte.use, former 
un signal de battement, et les impulsions de battement sont comptees pendant 
35 un intervalle predetermine pour fournir la distance d'un obstacle. 
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En variante, cette distance petit etre fournie par transformation de Fourrier. 

Avantageusement, Remission de chaque radar dure un temps limite et la 
logique de repetition peut meme etre codee en vue de Identification de la 
5 source. 

L'invention a egalement pour objet un dispositif pour la modelisation de 
I'environnement d'un vehicule, caracterisee par le fait qu'il comprend une 
pluralite de radars montes sur le vehicule et une unite de traitement agencee 
10 pour fusionner les donnees foumies par les radars. 

GrSce a l'op6ration de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de cout peu eleve. — - 

15 On observera que les radars de ce type, notamment les radars Doppler 
courants, sont generalement utilises en mesure de vitesse alors qu'ici, e'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventuellement utilisee qu'a titre accessoire. De surcroit, alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 

20 fonctionnant en impulsions, on utilise id de preference des radars a Emission 
continue et fonctionnant en modulation de frequence. 

On decrira maintenant a titre tfexemple non limitatif un mode de realisation 
particulier de Tinvention, en reference aux dessins schematiques annexes dans 
25 lesquels : 



- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de Pinvention, 

30 - la figure 2 est un diagramme fonctionnel de ces moyens, 

- la figure 3 illustre les signaux 6mis par les radars, 

- la figure 4 represente la modelisation de Tenvironnement du vehicule, 

35 
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- la figure 5 illustre la fonction de repartition des probability d'occupation d'une 
cellule par un obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probabilites d'occupation de 
5 cette cellule en fonction de I'ecart angulaire entre sa direction et Taxe de 

I'antenne. 

La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
laquelle sont montes une pluralite de radars 2, par exemple une vingtaine. Les 
10 radars 2 sont ici des radars a lobe large, c'est-a-dire d'angle d'ouverture 26 
typiquement compris entre 15° et et 120°. On rappelle qu'un angle 2G important 
est recherch6 pour obtenir une bonne couverture peripherique autour du 
vehicufe avec un nombre de capteurs aussi reduit que possible. ^ 

is Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sont places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
20 couverture de detection et de la moderation en general, depend directement 
du nombre de radars utilises dont les lobes individuals peuvent se rejoindre 
arbitrairement comme cela est repesente vers Pavant (fleche 3) et le cote du 
vehicule. 

On voit sur la figure 2 trois des antennes radars 2a, 2b et 2c. Chacune de ces 
antennes- est reliee par rintermediaire d'un drcuit cfinteface 4a t 4b, 4c — 
respectivement, a une unite 5 susceptible d'elaborer les signaux de 
declenchement Sa, Sb et Sc respectivement des radars. En variante, les 
signaux de declenchement peuvent etre communs a tous les radars. 

Les signaux Sa, Sb, Sc sont modules en frequence comme repr6sente a la 
figure 3. Une frequence porteuse Fp est modulee par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assuree au niveau de 
Tunite 5 par une diode oscillatrice GUNN. 
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Optionnellement, pour chaque signal Sa, Sb ( Sc, remission module dure un 
temps limite D. On facilite ainsi la differentiation des signaux regus ainsi que 
Textraction des informations recherchees. Par ailleurs, en codant la logique de 
repetition des emissions, c'est-a-dire la duree T sur la figure 3, par exemple 
5 selon un modele pseudo-aleatoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicules 
dans le meme environnement 

Le signal re?u en retour par chaque antenne 2a, 2b, 2c est traite dans une 
10 unit6 de traitement analogique 6a, 6b t 6c respectivement. 

Le signal re$u est dephase par rapport au signal emis. Par melange dans 
r "unite 6 TOrrespondante avec une fraction du signal emis, apres Elimination de ^ 

la frequence porteuse, un signal de battement £ une frequence type de Tordre 
is de 1 kHz est obtenu. 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
correspondent aux obstacles les plus eloignes. On ne retient ainsi que le signal 
retrodiffuse par le premier obstacle rencontre, qui est ensuite traite par 
20 transformee de Fourrier. 

Par ailleurs, la comparaison de la frequence de Tonde porteuse retrodtffusee.et 
de celle de Tonde porteuse du signal emis donne la frequence Doppler F<j qui 
est proportionnelle a la Vitesse de rapprochement ou d'6loignement du v6hicule 
25 de I'obstacJe d§tect6, selon la relation : 

v=1/2XF d 

ou X = c/F (vitesse de propagation/frequence Remission) 

30 

Uinformation de vitesse n'est pas necessaire a la mise en oeuvre de 
Tinvention. Sa disponibilite constitue neanmoins un avantage dans les 
applications. 

35 Les informations de distance et vitesse numerisees sont fournies par les unites 
de traitement analogiques 6a, 6b, 6c au processeur numerique 7. 
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Le processeur 7 est constitue pour I'essentiel d'une unite de calcul susceptible 
d'acc6der a une memoire 8. 

5 A chaque element de la memoire 8 est associee une cellule elementaire 9 de 
— Tenvironnement du vehicule. Le contenu de chacun de ses elements de 
memoire represente la probabilite pour qu'une cellule particuliere, rep6ree par 
son site <J> et sa distance d par rapport au vehicule, renferme un obstacle. 

10 La figure 4 represente 2 radars 11 et 12 ayant chacun detecte un obstacle, le 
premier a la distance d-j et le second a la distance d2- Par convention, on 
decide que la probabilite d'occupation d'une cellule par un obstacle est 

_ „ comprise entre -1 (la cellule est certainement non occupee) et +1: (la cellule esL _ 

certainement occupee), la probabilite p = 0 correspondant a Tincertitude. 

15 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probabilite d'occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de I'antenne et de I'ecart angulaire entre I'axe de visee de I'antenne et la 

20 direction de la cellule. A titre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de I'antenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cetfe antenne et la direction consideree. La probabilite maximale est bien 

25 entendu rencontr6e pour la distance d-| et dans la direction de vis6 de 
I'antenne. - r:.^^..:.— — 

Les differentes zones de probabilites sont portees sur les figures 4 a 6. La 
zone B de probabilite positive sur la figure 5 correspond a deux bandes 
30 annulaires de part et d'autre du cercle de rayon d-j. On verifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontre est pris en compte puisqu'au- 
dela d'une certaine distance (zone D) fonction de d-i aucune information n'est 
apportee par la mesure. De meme sur la figure 6, aucune information n'est 
apportee par la mesure en dehors du lobe d'esmission (zone A). 

35 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
representation de Tenvironnement etant d'autant meilleure que ces niveaux 
sont plus nombreux. 

5 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a Taide du radar 11, une probability p1 ^occupation de cette cellule 
par un obstacle et, par la mesure effectuee a I'aide du radar 12, une probability 
p2, on met en oeuvre Talgorithme de fusion suivant : 

10 

- si p1 > 0 et p2 > 0. 

Ffcl (P 2) = p1^ ~ ~ 

15 - si p1 < 0 et p2 > 0 

F(p1,p2) = p1 +p2 + p1.p2 

- si p1 < 0 et p2 < 0 

20 

p1 +P2 

F(p1,p2) = 

1 -Min(p1,p2) 

25 Cet algorithme peut etre mis en oeuvre de la fagon decrite ci-dessus, c'est-a- 
dire spacialement, en fusionnant les informations de probability provenant de 
deux radars, ou encore de maniere temporelle, en utilisant ('information de 
probability provenant d'un seul radar et en la fusionnant avec la probability 
deja prysente pour la cellule consideree dans la memoire 8. 

30 

Les probabilites d'occupation de I'espace s'expriment continument entre -1 
(cellule certainement vide) et +1 (cellule certainement occupee). On realise 
ensuite un seuillage des resultats de la fusion brute de maniere a obtenir une 
carte de I'environnement du vehicule sur laquelle sont portes les obstacles. 

35 
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On peut cTailleurs ameliorer la representation de cette carte en lui faisant subir 
une operation morphologique de type "fermeture" (dilatation - erosion), connue 
dans le domaine du traitement d'image. 

La carte ainsi obtenue fournit ainsi une information precise sur I'environnement 
du vehicule et permet : 

- son evolution avec eviternent eventuel d'obstacles ; 

- sa relocalisation par comparaison entre les emplacements mesures des 
obstacles et une connaissance a priori de ces obstacles. 

On peut par ailleurs enyisager d'autres syst6mes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
sonars. 
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REVEN DIC ATION S 

1. Procede de detection et de localisation d'obstacles dans I'environnement 
d'un vehicule, caracterise par le fait qu'il comprend les etapes consistant a 

5 emettre des signaux en direction dudit environnement a partir d'une pluralite de 
radars (2) disposes sur le vehicule, a deduire des signaux re?us en echo les 
probabilites d'occupation par un obstacle d'un ensemble de cellules 
elementaires (9) dudit environnement, et a fusionner les probabilites relatives a 
chacune desdites cellules. 

10 

2. Procede selon la revendication 1 , dans lequel la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

15 3. Proc6de selon Tune quelconque des revendications 1 et 2, dans lequel la 
fusion est effectuee sur la valeur de la probabilite fournie par un radar et la 
valeur de la probabilite anterieurement connue par la meme cellule. 

4. Procede selon Tune quelconque des revendications 1 a 3 ( dans lequel on 
20 deduit, des signaux regxis en echo, une information de distance et une 

information angulaire sur les obstacles, et on determine lesdites probabilites 
d'occupation a partir de ces informations. 

5. Procede selon Tune quelconque des revendications 1 a 4, comprenant une 
25 etape de seuillage des resultats de la fusion. 

6. Procede selon Tune quelconque des revendications 13 5, dans lequel le 
signal emis par les radars est module en frequence, le signal re$u en echo est 
melange a une fraction du signal emis pour, apres elimination de la frequence 

30 porteuse, former un signal de battement, et la distance d'un obstacle est 
obtenue soit par transformation de Fourrier soit par comptage pendant un 
intervalle de temps predetermine. 

7. Procede seion Tune queiconque des revendications 1 a 6, dans lequel 
35 remission de chaque radar dure un temps limite, et la logique de repetition est 

cod6e en vue de Tidentification de la source. 
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8. Dispositif pour la detection et la localisation d'obstacles dans 
I'environnement d'un vehicule, caracterise par le fait qu'il cornprend une 
plurality de radars (2) montes sur le vehicule et une unite de traitement (7) 

5 agencee pour fusionner les donnees fournies par les radars. 

9. Dispositif selon la revendication 8, dans lequel les radars sont a lobe large. 
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